#include "FreeRTOS.h"
#include "task.h"
#include "main.h"
#include "tim.h"
#include "cmsis_os.h"
#include "Hardware_DWT.h"
#include "Hardware_OLED.h"
#include "Software_OLED_Data.h"
#include "Software_Chassis.h"
#include "User_Task.h"

uint32_t debug_num = 0;

void Task_PSCheck(void *argument)
{
	while(1)
	{
        debug_num++;
        DWT_Delayus(10000);
        vTaskDelay(1);
    }
}

void Task_Init(void)
{
    // OLED_Init();
    DWT_Init();
    HAL_TIM_Base_Init(&htim1);
    HAL_TIM_Base_Init(&htim2);
    HAL_TIM_Base_Init(&htim3);
    HAL_TIM_Base_Init(&htim4);
    HAL_TIM_Base_Init(&htim5);
    HAL_TIM_Base_Init(&htim8);
    HAL_TIM_Base_Init(&htim9);
    Chassis_Init();
}